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ABSTRACT 


Multivariable control theory is used to design a controller for a 
modified drooping stern turning submersible. The procedure used is 
based on the LQG/LTR methodology. The controller is designed from a 
linear model and tested for performance on a nonlinear system model. 
Control variables are turning velocity, roll, and pitch. The resulting 
controller successfully minimizes roll and pitch for a turning submer- 
sible. 
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CHAPTER 1 


INTRODUCTION 


Pt imtcoduct lon 


In the present age of high technology and sophisticated develop- 
ment of vehicles, both air and submersible, designers continue to push 
the performance limits of their designs, due to increased demands on 
System requirements. Aircraft are required to perform faster, at higher 
and lower altitudes. Submersibles, especially submarines, are being 
designed to dive deeper and faster. It is this last category of ve- 


mreles that this thesis addresses. 


The operating envelope of a submarine is predicated on its design 
depth and speed plus its ability to handle a mechanical casualty with 
enough time to recover before exceeding test depth of the hull. Cur- 
rently, submarines have the capability to operate at depths greater than 


700 feet and speeds in excess of 30 knots. 


The current hull design has been determined to be the most effi- 
cient hydrodynamic design and has evolved from the Albacore. Addition- 
ally, the rudder and sternplane cnfiguration has basically been un- 
changed from the cruciform design for decades. The cruciform stern is 
quite a sensible design in case of a casualty situation. When one wants 
to climb or dive, all one has to do is either command rise or dive on 
the sternplanes. To turn, a similar situation exists. One just needs 
to turn the rudder in the desired direction one wants to go which also 


Causes the boat to dive. However, the cruciform stern arrangement has 





its drawbacks. There is no differential control, i.e., both the upper 
and lower rudders are mechanically tied together as are the right and 
left sternplane control surfaces. A severe casualty such as a stern- 
plane jam on dive does not allow for independent action on the stern- 
plane control surface. The corrective action to combat this casualty is 
to quickly reverse propulsion power direction and command full rise on 
the sailplanes. All of this corrective action must be accomplished fast 
enough, before the boat exceeds test depth. Finally, the cruciform 
stern does not effectively allow the boat to maintain a level attitude 
in a turn. The boat has a natural tendency to roll thereby causing the 


rudder to contribute to pitch as if it were a stern surface. 


In order to effectively correct the drawbacks of the cruciform 
stern, an alternative stern configuration could be used employing dif- 
ferential control of its surfaces, i.e., each surface independently 
Operated. The independent action would allow the operator to deflect 
the control surfaces that effect depth in a casualty. Also, if a stern- 
plane jam casualty occurred, then the plane that did not suffer the 
casualty could be used to control the rate of depth excursion, while the 
propulsion plant is used to slow the vehicle. Differential action of 
the stern control surfaces can also be used to counteract the forces 
that cause roll, thereby prohibiting undesirable depth changes of the 


vehicle. 


The stern configuration that will be considered in this thesis is 
called a modified drooping stern (MDS). The MDS consists of a single 
rudder surface with two dihedral surfaces 37.5° below the horizontal. 

In theory the MDS should be able to effectively control roll and enable 
the operator to combat a sternplane casualty. However, the MDS presents 
the operator with a coordination problem in that its movement is not so 
straightforward; for example, for normal cruising, how should one de- 
flect the dihedral surfaces to control the effects of roll? It there- 
fore becomes of considerable importance to design an automatic control 


system that handles such a vehicle in operation. 





In this thesis a truly multivariable automatic controller will be 
designed for the MDS configuration. Since there exists a number of 
Operating points within the submerged envelope, we have selected as a 
nominal design point that which describes the situation of a two degree 
deflection of the rudder and small deflections of the dihedrals, while 


the boat is at a velocity of 21 knots. 


A sketch of the proposed submersible is located in Figure 1. The 
overall length is 180 feet with a top speed of 21 knots. Mass proper- 
ties are summarized in Appendix A. The convention for positive deflec- 
tions of the control surfaces are shown in Figure 2, using the right 
hand rule system. The rudder and dihedral surfaces will be referred to 
as Dl, D2, and D3 and will be limited to a maximum deflection of plus or 


minus forty degrees. 


The mathematical model used for the control design utilizes the 
six degree-of-freedom nonlinear differential equations as developed by 
Gertler and Hagen known as the NSRDC Model 2510 [1]. The linear hydro- 
dynamic coefficients employed in the 2510 equations are derived in Chap- 
ter 2. All nonlinear coefficients used are based on submersibles of 
similar size and shape. Since this submersible has never been con- 
structed on scale basis or tested in a tow tank, the accuracy of the 
coefficients could not be verified. However, the computer model behaved 
in a reasonable manner as one would expect with a full scale equivalent 


model. 


The origin of the submarine fixed axes is located at the center 
of gravity. The positive directions of axes are: x-direction, forward; 
y-direction to starboard; z-direction downward. The linear and angular 


velocity components, forces and moments are shown in Figure 2 [6]. 


This thesis will develop and design a multivariable automatic 
controller for the submarine model in Chapter 2. Chapter 2 consists of 
the development of the linear hydrodynamic coefficients and explains the 


modifications made to the six degree-of-freedcm equations of motion. 
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Figure 2. Sketch showing positive directions of axes, 
angles, velocities, forces, and moments. 
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Additionally, an explanation is provided as to how the equations of 
motion were linearized. Chapter 3 consists of the controller (compen- 
sator) design. It includes a brief explanation of the control varia- 
bles, system augmentation, and calculation of the control gain matrix, 
G, and the filter gain matrix, H, which result from the frequency domain 
loop shaping methodology employed for the design. The design method- 
ology itself is also discussed briefly. Chapter 4 summarizes the re- 
sults of the nonlinear controller simulations. Finally, Chapter 5 lists 
the conclusions and recommendations as drawn from the resultant sub- 


marine model and controller design. 


ie 2 Contributions of Thesis 


The contributions of this thesis is twofold: (i) evaluation of 
the MDS configuration for a submersible in a high speed turn, 
(ii) design of an automatic control system to facilitate the MDS opera- 
tion using. Linear Quadratic Gaussian/Loop Transfer Recovery (LQG/LTR) 


methods. 


The emphasis is on the frequency-domain properties of the state- 
Space based LQG designs. Simple and efficient tools for loop shaping 
are employed that lead to satisfactory designs. These tools accomplish 
Singular value "pinching" in the high and low frequency ranges, so as to 


satisfy stability and performance requirements. 


Moreover, this thesis tests the controller designed on the basis 
of a linear model on the nonlinear process model which is a better 


approximation to the actual system. 
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CHAPTER 2 


THE SUBMARINE MODEL 


ee. Nonlinear Equations of Motion 


The equations of motion describing the design vehicle in this 
thesis as already mentioned, were the six degree-of-freedom equations 
contained in the NSRDC document 2510 [1]. The coefficients of the equa-~ 
tions, as developed in Section 2.3, describe the vehicle's geometry. 
Modification was made to the equations to account for the geometry of 
the MDS configuration. The terms that involved both rudder and stern- 
plane action were combined; these can be seen in the lateral force, 
pitching moment and yawing moment equations. The factors that premul- 
tiply the ccrresponding surface deflections were based upon the geometry 


depicted in Figure 3. 


Dl is primarily used for rudder control while control surfaces D2 
and D3 are used for depth and roll control. However, D2 and D3 can also 
act as an additional rudder and their potential contribution can be seen 
from the lateral force equation where the multiplying coefficient is 
given by sin 37.5° = 0.6088. The resulting term looks like the follow- 
ing, Dl - 0.6088D2 + 0.6088D3. Additionally, this term takes into ac- 
count the sign of the hydrodynamic coefficients Ys and 2). Lie thas 


on 


case both Ys and Von are positive and employ the sign convention as 
established in Figure 2. Likewise, the stern contribution terms in the 


pitching and yawing moment equations have similar form. 
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For depth control, surfaces D2 and D3 are used. The factor 
cos 37.5° = 0.7934 appears. Depending on the sign of the hydrodynamic 
ccefficients Zs» ane Mes Te Nas and Non? the sign of the deflecting 


term is assigned. 


One must keep in mind that, not all hydrodynamic coefficients 
involving a control surface have a value that can be predicted or meas- 
ured in model tests. If a value could be determined, then one would 
assign the additive or subtractive nature to the contribution of the 
control surface based upon the sign of the corresponding hydrodynamic 
coefficient. The resulting nonlinear and auxiliary force equations are 


given in Appendix B. 


D2 Linearized Equations of Motion 


Control design requires that the nonlinear equations of motion be 
linearized about a nominal operating point. The nonlinear equations are 


of the form 

Ex = f(x, u) (2.1) 
from which one can derive the linearized equations in the form 

EAx = AAx + BAu C32) 


which represents a Taylor Series expansion of the nonlinear equations 
about a nominal point x. and u,? by retaining only the first order 
terms. More specifically, expanding Equation (2.1) in a first order 


Taylor Series around a nominal point, one gets 


of (ee) JE Ce UU) 
ee 


Ex + EAx = f( uo ee X~ X, 


> 


X 
=0 


aS, 


i _ Z _ , 
If one lets Ax = (x x) and du = (u u,) where x, is the nominal 


state vector and uo the nominal input which, furthermore, are known to 


satisfy the original nonlinear equations, then one is left with 


- _ 920859 Yo? See 
EAX = Ax + ——— Au (2.4) 
sf (x> ue) Cl 3 a. 
muere A = a and B = ee sc me The linearized equations are 


listed in Appendix C.. 


Additionally, the full nonlinear equations include crossflow and 
vortex shedding terms. For the purpose of this thesis, the crossflow 
term was linearized while the vortex shedding term was omitted. The 
reason for this was to be able to compare the results of this submer- 
sible to a full scale model, whose linearized equations did not include 


vortex shedding, either. 


Ze Hydrodynamic Coefficients 


The hydrodynamic coefficients that comprise the linear and non- 
linear equations of motion are very important in the mathematical model. 
The linear coefficients can be estimated using equations based on the 
geometry of the submersible. The nonlinear coefficients are normally 
the result of model tests either in a tow tank or wind tunnel. The 
coefficients not calculated in this thesis are taken from past designs 


of similar size and shape vehicles. 


2.3.1 Body Coefficients [2] 


We assume a prolate ellipsoid for the hull shape, where the major 


and minor axes are given by 


16 





_ 4 2 
V= 3 Tab 
3 
N= 057,099 fe 
The buoyant force of the ellipsoid is 
B = pV 
6 

Bee 2.4203. 0 FLbi. 


The surface area of the ellipsoid is given by 


S = Doe + 27 = sin e 
where 
Bice Cc 

e = eccentricity = = 

i 
ae ea = b*)* 
e = 0.9938 

Z 
S = 8932.4 ft 


a_ 


From Lamb [3] with 5 


9, the factors 


17 


can be obtained. 


The moments of 


0.8645 


Hl 


0.0241 


52536 


inertia for the body are as follows: 


I ae for a prolate ellipsoid 
ay 2 
B 2.4283 x 10° lpf 
[emo o. = ~~ ee 75483 slugs 
32.17 = 32.17 —= 
2 2 
Ss Ss 
2. 2 
if me Eb) eee Ox 10° aie cee 
yy 2 
= 8 Z 
i = 1.2379 x 10° slugs-ft 
ZZ 
m(2b7) 
Ios 
sex 5 
6 2 
It = 3.0193 x 10 slugs-ft 
xX 


The mass and moments of inertia can be nondimensionalized by 


dividing with the appropriate factor. 


is 











T' = 
ge 
Z 
m 
m’ = - 
(2) 
Z 
Therefore, 
i = [' = 0.000654 
yy ZZ 
ee = 0.000016 
XX 
m' = 0.1293 


The center of gravity is assumed to be located in the port- 


starboard plane of symmetry, 12 inches below the centerline. 


Xo = 0 
Yo = 0 
Zo = 1 ft 
Nondimensionalizing, 
Z. = “c = 0.00556 
G Q 


From Newman [4], the Reynolds number for a body in 10°C seawater at 


21 KTS, is given by 


Be 


(21) (1.689) (180) 
1.35 x 10°°(3.281)2 


4.3931 x 10° 


Assuming that the frictional drag coefficient is equal to the drag coef- 


ficient and using the ITTC frictional resistance line gives 


ce, 7 e : 0.075 ; 
(logy, R - 2) 
Cy = C, = 0.0017 


for the coefficient of drag. 


The body hydrodynamic coefficients can now be calculated [5]. 


CS 


y' = sk be ete = -0.008009 (2 
V 9? 

a = -(0.10 - K,)m' = 0.000981 (2a 
A. = XY" ~=— —0. 008009 (2. 
W V 

Ze 7 9) 0. 0009S! (Ze 
q ig 

M' = 0O.87(K, - K,)m' = 0.010458 ce 
W 2 l 

a =m O04 o\( meee 0, 000562 (2s 
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5) 


6) 


yy) 


8) 


9) 


10) 


N! = M! = 
Gg 
off aes ' 
Xx K\m 
ant = om 1 
y Km 
eZ, 
VetaeeS) ee 
Q 
Ket — Vs = 
p 
Ze' = Ye' = 
V 
Me' = -K'I' 
q iy, 
N-! — M:! — 
r q 


meoe2) Fin Coefficients [6] 


-0.010458 


=0., 000562 


SO WOE luz 


OR Ol23 95 


-0.000069 


-0.000069 


-O. Ol2359 


= -0.000565 


=0 5000565 


or 


(2. 


CZ 


C2 


(2 


(2 


2. 


CZ. 


(Ze 


1) 


IZ) 


Hop) 


14) 


15) 


.16) 


ee) 


18) 


19) 


The MDS stern configuration introduces asymmetry about the cen- 


terline of the vertical plane. Several views have been depicted to 


allow calculation of areas, aspect ratios and planes of motion. 


ures 3 and 4 depict fin dimensions. 


For a single fin: 


A = Projected area 


zal 
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100.4. ft 


Si 








PROJECTED AREA = 100.4 ft2 


RUDDER 









PROJECTED AREA = 100.4 ft2 


az fA DIHEDRAL 


Figure 3. Rear view, rudder, and dihedral fin dimensions. 
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SCALE: 1/8 in. = 1 ft 
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PROJECTED AREA = 194 ft2 














es ee PROJECTED AREA OF LOWER 
PLUME PROJECTION = 28.8 ft2 
| Dott 
— are. 
8.5 ft = | 
s | 
c 
| . 
ce 
ANG cr VERTICAL 


PROJECTED AREA = 186.4 ft2 


PROJECTED AREA OF 
MOVEABLE PORTION = 68.9 ft2 
2.2 ft 


Ze 
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Figure 4. Vertical and horizontal plane projections. 
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A = Projected area of movable portion 


m 
= 80.6 ae 
AR. = aspect ratio of fin = = 
c 
eee Sect c = 8.25 ft 
AR - = 3.394 
AR = aspect ratio of the movable portion 


One 22 


For the horizontal plane projection contributions, one has: 


Aup = projected area of the horizontal plane 
= 186.4 ee 

AR = aspect ratio in the horizontal plane 
= 2.69 


The following definitions are used in calculating A and Chas 


In the vertical plane 


AR. = 3.394 

Z 
A, = 100.4 ft 
Ch =e) 3 


24 





ae = distance from center of buoyancy to center of pressure 
of the stern 


The center of pressure is assumed to be 1/2 the mean chord length 


forward of the hailing edge. For this vehicle 





ven = -94.5 ft 
Cay CAs) 
oy Se onamhe (2.20) 
Vv 2 
2 
y'X 
hoe ost = 0.006431 (2.21) 


The contribution to roll due to asymmetry is 





where Bae was calculated by summing the different components of the 
vertical projection times their moment arm and then divided by the total 


area. 


For this vehicle a value for ae was found as 


Zz, =, Ico fe 
Cp 


Therefore 


Kl = -0.000742 (22) 
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For the horizontal plane projection 





a = 2.64 
2 
A = 186.4 ft 
oA = 3.604 
whereby 
-C, A 
Bea ee 20020733 (2. 
W Zz 
Q 
-Z'X 
M' = amen = -0.010885 (2 
z' = M' = -0.008673 OO. 
q W 
y' = N' = 0.006276 (2 
r V 
“KX, 
K' = ae ei = -0.000380 cn 
~Z IX 
Mioo= So = -0.004553 (2 
Y'x 
N'oo= i = -0.003295 Co 


23) 


.24) 


23) 


-26) 


27) 


225) 


Zo) 


In order to calculate a the method will be applied to an indiv- 


teual fin. 
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2 


A = 100.4 ft 
Cy = 3.953 
-—~C. A 
yt = aaa = -0.012249 
g 
then 
Ze WIND 
oe vat ( ep | 
P V se 


are is the distance from centerline to center of pressure of the 


individual fin. For this fin oe = 7.44 ft 
= = -0.000021 
The = for the design vehicle will be three times the above value. 
ss = -0.000063 (2-30) 


Abkowitz [7] provides a means for calculating the acceleration 


derivatives. In the horizontal plane 


where s is the span and c is the chord. 


Sea oneelctte st lle) fie] 922.2 fe G = 26.25 ft 


27 








Z-' = a —OnOdoast (Deo) 


In the vertical plane, 


where 
eee ae fe t+ 8.5 ft = 22.5 £t Ce eS ee 
Hence, 
er = -0.000336 (22) 
7" 
mi fe SP = -0.000174 (2533) 
-Y-'x 
Ne’ = aaa eles = -0.000176 (2.34) 
eae Me ae ©. 000174 Ons) 
q W 
x Zz 
Metee= a7 =) = -0.000091 (2.36) 
q W me 
x Z 
Net = ye! (“<2 = -0.000093 237) 
r V Q 
Veg 
i a ara = -0Q.000020 (2 = 38,) 


ie = Ne' = 0.000176 (2239) 


Vv 


Contributions due to the deflections of the fins result in the 


following coefficients, for which it suffices to calculate those for one 





ein only. 
; raat 
ar 2 
Q 
a = AR = 3.394 
Creates 195 
a one Bea 
¥' = 0.005706 
C 
gi Lo _ =0.007656 (2.40) 
§ 2 
4 
WePPEcen = 3.6 and A. = 68.9 ft 
where yaar: Ay - ji 
ea 
Ki = a = 0.000269 OS 


where aes is the distance for the moveable portion, -8.46 ft. 


Mi = ae = =p04019 Cals 
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an - Kop 


where Ay = 28.8 fc 


Z 
it 


~0.001680 (2.43) 


When the fins are deflected, drag forces are induced. The drag 


force of a body is given by 


l Z, 
x = 5 CpPAu, 
From Comstock [8], 
Cy 
Cy ~ Ho Tae 


where 
a = AR = 1.182 
e = 0.9 (Oswald efficiency factor) 
Since 
dc 
L _ 
Cy = (+) oe ass 
then 
5 6 a Nae 
oT) DO ° 
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Substituting this into the X equation, 


Z 2 
es One lt Joa u 


xX = 
9 


{ 


and, taking the second derivative with respect to Oy> one gets 


7 2 
Kee = 0.81460A,u 


Next, nondimensionalizing, 


Xe = (22) = -0.004053 (2244) 


ese > Sail Coefficients 


Figure 5 shows the dimensions of sail used. Using the method 
described in Reference 8, to evaluate Ch for the sail one calculates 


the following. 


jeee= tO radian for sai 
AR = a = OD: = 2S 
Ss 16 
A = 160 Eo 
27 
Cy = an = 2.42 
AR 


Sl 





SCALE: 1/4 in. = 1 ft 


DN 
-<————_- 8 ft —____—_» 
fe 58 ft. ——— $$ _—_“*\ A FP. 


a=8ft 
b = 4 ft 


anV1/2 (a2 + b2) ¢h 


397.4 ft2 


SURFACE AREA 


As 


Figure 5. Sail geometry. 
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y" = = =0F Ol lo34 (2.45) 


The center of pressure is assumed to be located at the 1/4 chord length 


from the forward edge. 


xX = 28 ft 
cp 
“YX 
N' = eae = (0.001856 (2.46) 





where Zep TSetnme Gistance from the centerline of the venicle to the 


vertical center of pressure, and ae = aan = -15 ft for this submersible. 
Then, 
Ky = 0.000155 (2.47) 
Y' = N' = Q.001856 (2.48) 
r V 
YX 
Ni = —,~ = 0.000289 (2.49) 
ZN 
Ky = YX" (“se | = -0.000083 (24:50) 
P Vv Q 
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The acceleration derivatives, according to Abkowitz can be de- 


rived analogously as for the stern control surfaces. 


In this case, the 


span will be twice the height of the sail and the resulting derivative 


will be divided in half and then nondimensionalized. 


plane one gets 


where 
Ssee= 20°08 


oa LO LEt 


Hence 


-0.000886 
“Ye "x 
=o = 0.000138 
Ye 7 
aaa = 0.000074 
x Zz 
ye! (<2) = -0.000021 
N-' = -0.000138 
Z 2 
ye! (£2 = -0.000006 


inv ener vVerlicaL 


C510) 


2552) 


(27.53) 


(2.54) 


(Ea) 


(2750) 





@s.4 Sailplane Coefficients 


Figure 6 shows the geometry of the sailplane. The center of 
pressure is assumed to be 1/2 mean chord length forward of the trailing 


edge. For this vehicle, 


x = 24 ft 
Cp 


The following definitions are used in calculating A and C 


ica 
b = tip of fin to hull centerline 
= itt 
d = maximum diameter of hull 
= 20 ft 
a= aspect ratio = 2.6/7 for a single plane 
A = 31.5 fee 
Cry ore, 
Cc) A 
' — eee i = 
ae oe 0.003490 C2258) 
fate 
Mi = —~— = = 0.000465 (2.58) 


itiere is mo contribution to roll in the horizontal plane. 
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7 i 
SCALE: 1/4 in. = 1 ft 


PROJECTED AREA OF 
7 ft SINGLE FIN = 31.5 ft2 


2 ft>l 


co 
+ 


Figure 6. Sailplane geometry. 


36 





= 

Zz! = a = 0.000465 (2.59) 
7x 

M! = See = (0.000097 (2.60) 


The contributions due to the deflection of the fins are calcu- 


lated in a similar fashion as before. 





Lie = = -0.005429 CZ 61) 


where oe for the sailplane is 16 ft. 


Zs |x | 
Los Saar ea = 0.000724 (2262) 


M 
As with the stern control surfaces, when the fins are deflected, 


drag forces are induced. 


a = AR = Seis 


msp 


Q| [wn] 


0.9 (Oswald efficiency factor) 


(D 
I 


Since 
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then 


cr 
Cy ~ Cn bs Tae 


Choo + 0.450162 


Substituting this into the expression for the drag force of a 


l 2 
body x zat CpeAu gives 


2 2. 
i + 0.45016 oa, ou 


x = 


Taking the second derivative with respect to 64, 


Xs = ee ee 


Nondimensionalizing, 


*a 
ee eon so (2.63) 


66 2 ue 
Z 


The acceleration derivatives for the sailplanes are calculated as 


follows, with c = 5.25 ft and s = 14 ft. In the horizontal plane, 


(: : 0.54 ) 
14 = 
mC as 5) (1 a een 


Gey Ses) 2 
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ze = 0.000092 (2.64) 
Ze 1X 
M-' = ae = (0.000012 (2.65) 
o! aaa a — 
Ze M- 0.000012 (2.66) 
x. 2 
ee Ze" (“ce) = -0.000002 (2.67) 


The hydrodynamic data to be utilized by the SUBRUN computer program, 
that will generate the linear dynamics, requires that the coefficients 
be input in a dimensionalized form rather than a nondimensionalized 
form. Appendix D contains a listing of dimensionalized hydrodynamic 


data and dimensionalizing factors for this purpose. 


mG Computer Program Description 


The computer program, SUBMODEL, used for this thesis was devel- 
oped at Draper Laboratory [9]. The program has the capability to inte- 
grate the nonlinear equations of motion of a submarine; search for a 
local equilibrium point in the nonlinear equations of motion; calculate 
the linearized dynamics of the linearized equations about a nominal 
point; integrate the linearized equations of motion; simulate the com- 


pensated vehicle using either the nonlinear or linear equations. 


As previously stated, the nonlinear equations take the form of 


Pauation (2.1) 
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where 


Poe uelOe el State vector with states u, v, w, Deiat epics 
theta, psi and z, the last four describing the vehicle 


attitude with respect to an inertial reference frame. 


u = 4 x 1 control vector with DB, Dl, D2, D3 as members 

£ = lO x isvecton that iseaemonlinear function of the states 
and the controls 

= 10 x 10 matrix 


The nonlinear equations were integrated with the RPS propulsion 
model, as described in Appendix E, using as input a velocity in feet/ 
second (corresponding to 21 knots) with initial values of zero for all 
states, with the exception of Dl deflected to 2 degrees, D2 deflected to 
0.5 degree and D3 deflected to -0.4744 degrees. The assumption is made 
in the propulsion data that wake and thrust deduction factors vary 
slightly and are therefore considered constant. The nominal point is 
then determined by integrating the nonlinear equations with the eta 
propulsion model using as inputs for the states, the final value of the 


states from the RPS integration. 


Once the nominal point has been determined, the linearized dynam- 
ics can be calculated by linearizing about that nominal point (see Ap- 
pendix E for a description of Nominal Point). Recall that the linear- 


ized equations are of the form 
EAx = A'Ax + B'Au (2.68) 
or, equivalently, the conventional representation form 


1 
r Hh 


x = E A'x +E Blu = Ax t+ Bu (2.69) 
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On can easily see that A in state space form equates to g tat and B 
-1 .. owl - ee _ 
equates to E B'. It is E “A' and EB! that define the linear system 


dynamics, on which the control design is based. 


To validate the resulting linear model, one perturbs the states 
of the nominal point and compares the resulting responses of the per- 
turbed linear and nonlinear models. Perturbation from the nominal point 
on the order of 10% is adequate for checking validity of the linear 
model behavior in comparison to the nonlinear model. Figure 7 shows the 


graphical responses of the two models for comparison. 


Once the controller has been designed, the effectiveness of its 
Operation can be tested by using it on the previously derived linear and 
nonlinear models and analyzing their responses to step and ramp inputs. 
A description of the controller development is given in Chapter 3 with 


the results of the subsequent testing in Chapter 4. 
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Figure 7. Linear and nonlinear submarine model responses. 
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LINEAR RESPONSE (CONT'D) 
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NON-LINEAR RESPONSE (CONT'D) 
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CHAPTER 3 


COMPENSATOR DESIGN 


eB, 1 Overview of the LQG/LTR Procedure [10] 


In this chapter, a controller will be designed using the LQG/LTR 
design procedure. The singular value loop shaping approach will be used 
to mold the singular values of the system open-loop transfer function to 
meet the specifications of performance and robustness to plant uncer- 
tainty and modeling errors. In order to meet the performance specifi- 
cations of small steady state errors, one desires high DC gains. To 
minimize the effect of wave encounter and modeling errors at high fre- 
quancies, we desire crossover at about Q.1 radians per second with a 
large roll-off after crossover. This will ensure attenuation of high 
frequency modeling errors and sensor noise, as well as wave effects 


which typically occur in the 0.2 to 2 radian range. 


The LQG procedure is a mathematical method of designing a robust 
multivariable controller for a state space system. The designer, how- 
ever, has the flexibility to pick the parameters of the design motivated 
from a frequency domain setting. An iterative design process is then 
carried out, during which the designer is able to match desired fre- 
quency domain characteristics, captured by the singular values of the 
multivariable system, which are equivalent to the SISO Bode plots, by 
using time-domain mathematics as derived for the solution of the origi- 
nal optimal control problem. In this way, a systematic procedure can be 
carried out, with the mathematical solution kept simple and in closed 


form for even a complex MIMO design. 
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The design is based on the feedback loop as represented in Fig- 
ure 8. The plant G(s) has an input u, and output y, a disturbance d as 
seen at the output, and measurement noise vector n. The compensator is 


designated as K(s). 





Figure 8. Generalized feedback loop. 


The plant G is the physical system to be controlled and can 
therefore behave in a complex manner, as implied by the term nonlinear, 
infinite dimensional and time-varying which are used for its modeling. 
To simplify the situation, we desire G to be linear, finite and time- 
invariant (as results from the linearization procedure described in the 


preceding chapter), with a transfer function G(s). 


The design objective will be to provide good command-following, 
good disturbance rejection, and small responses to sensor noise, all 
subject to the constraints imposed by modeling errors. Hence we need 
large loop gains in the frequency ranges where commands and disturbances 
are large and small loop gains in the frequency ranges where modeling 
errors are large, as well as a well-behaved crossover. These frequency 
domain requirements can be captured as shown in Figure 9, where the 
maximum and minimum singular values of the loop transfer matrix envelope 
the MIMO system performance, and can be directly interpreted as SISO 
Bode plots. For a good design, it becomes necessary to use techniques 


which directly take plant descriptions and performance specifications 
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Figure 9. Frequency domain requirements. 


into consideration and systematically produce a controller which satis- 
fies the singular value requirements of Figure 9. The multivariable 
design technique, LQG with Loop Transfer Recovery, is able to perform 


such a direct singular value loop-shaping. 


As previously stated, the LQG/LTR methodology was developed to 
perform control system design on the basis of time-domain optimization. 


The method uses the following state space description of the plant, G: 
x =e Bie 6 (3.1) 
Pao eal (a2) 


where x is an n-dimensional state vector, u and y are m-dimensional 
control inputs and outputs, and & and n are white noise processes. The 


A, B, and C matrices satisfy 


G(s) = C$(s)B (3.3) 
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where $(s) = Gia The feedback design task is to find a control 
law u(t) that satisfies the specifications. For this purpose, the math- 
ematics developed for the solution of the following optimization problem 
are employed, although the design is geared towards loop-shaping and 


clearly cannot claim optimality as will be seen in the sequel. 


alk 
Min J = f [x" (t)Qx(t) + ul (t)Ru(t)] at (3.4) 
0 


where the R matrix is the control weighting matrix and Q is the state 


weighting matrix. The solution of this optimization problem is given by 
We) See On), (3.5) 


where G is a full-state linear quadratic regulator (LQR) gain as defined 
in the Control Algebraic Riccati equation (CARE). However, in the LQG/ 
LTR procedure, the solution is carried out in two stages. First, the 
filter gain matrix, H, is found by solving the Filter Algebraic Riccati 


equation (FARE). 


The objective in this first step is to shape the singular values 
of the Kalman filter (filter gain) matrix according to the specifica- 
tions, as suggested in Figure 9, and then recovering the same loop 
transfer matrix shape for the singular values of the overall system loop 
transfer matrix T(s), which includes the plant, any augmentation, and 
the controller gain matrix G, which is obtained as a second stage solu- 
tion, by solving the CARE, for a given filter design. This compensator 
Structure is referred to as a Model Based Compensator (MBC), because it 
makes explicit use of the plant linear model (i.e. A, B, C matrices). 


At the end of the second stage, the overall system matrix is obtained as 


T(s) = Gp(s)K(s) (3.6) 
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-] 
Where K(s) = G(SI - A + BG + HC) “H. Once the shape meets the design 
specifications, we are further guaranteed that the poles of [A - HC] and 
[A - BG] will lie in the left half plane, i.e., no instabilities will be 


introduced into the nominal system, provided [A, B] are stabilizable and 


[A, C] detectable. 


5.2 Modal Analysis 


Since this thesis emphasizes primarily the influence of the MDS 
configuration, the decision was made not to address the effect of the 
sailplanes. Additionally, the states psi and z are of no direct inter- 
est because of their non-effect on the other (body) states. The origi- 
nal plant A matrix contained zeroes in the columns designated for psi 
and z. By ignoring psi and z, this reduces the plant matrix to an 
(8 x 8) matrix, the control matrix to an (8 x 3), and the output matrix 
to a (3 x 8). It then becomes necessary to determine which states to 


use for the purposes of control. 


The MDS arrangement has the unique potential to control roll, 9, 
(and pitch, 6) via D2 and D3. Finally, for the third variable, turning 


velocity, r, (yaw rate), could be controlled with Dl. 


At the outset, the corresponding poles and zeroes of the plant 
Were determined. The variable combination $¢, 8, and r provided no non- 
minimum phase zeroes and no unstable poles. Table 1! lists both poles 


and zeroes for the open-loop plant. 


A modal analysis was then conducted to ascertain the relative 
controllability and observability of the system. To examine the con- 
trollability of a system, one is interested in the ability of (a) parti- 
Pibar input (s), in this case, Dl, D2 and/or D3, to control the (entire) 
State of a system. The observability of a system tests the possibility 
of observing the complete state of the system through a particular out- 


put, i.e., r, ¢ or 8. Using the augmented system A, B and C matrices 
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Table 1. 


Augmented Plant Poles 


-2 .029353579E-02 

-4.377357711E-02 

-1.803910515E-01 

-1.843174783E-01 

-6.227811352E-01 

-6.583723063E-01 

-5.085034079E-O1 + 5.224757797E-01 
0.000 (Multiple of 3) 
-1.000E-0O1 (Multiple of 3) 


Augmented Plant Zeroes 


-4.421289192E-02 
-1. 98463495 1E-01 
=, 205026200801 


(augmentation to be described in Section 3.3), the corresponding eigen- 
values and eigenvectors were calculated and a modal analysis performed 
in order to study the controllability and observability properties of 
the system. The eigenvalues give the response time of a system's modes 
while the eigenvectors represent the relative contributions of each 
State to a particular mode, represented by the corresponding (normal- 
ized) eigenvector. For example, the plant can be described in state 


space from by, 
x = Ax + Bu Ga 


y = Cx ao) 
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If we let x = Tz, for any nonsingular T, we can define a new system. 
However, one must remember that z does not describe the physical state 
space. TI can be chosen to be the matrix of eigenvectors. Using this 
change of variable transformation, one gets that x= Tz. So if one 
makes this change of variable substitution into the state space equa- 


tions (3.7) and (3.8), one is left with 
x Ze het (39) 
y = CTz (3.10) 


To complete the transformation, Tie iow Crp ited semrOucinn( 34) sce 


(3.10) thus yielding 


2 = TATz gen Gel 
The net effect of the above procedure is the diagonalization of the 
state equation where the elements on the diagonal correspond to the 


eigenvalues of the system, if they are distinct. Rewriting the modal- 


domain state and output equations for MIMO system, one gets 


e * 
Za eize tes U (3.12) 


Vere Coz (3.13) 


* 1 


= * 
fierce RB = lyeBs © = CT, and A is a diagonal matrix of eigenvalues. 


For a system to be controllable by an input u or observable by output y, 
# * 

the column matrix B or the row matrix C must not contain zeroes in a 

SISO setting. In a MIMO setting, if zeroes appear, then there must be 


* e 
at least one nonzero entry in the B matrix and one nonzero entry in the 


eZ 





= 
fe matrix for a particular state to be controllable and observable by at 


He-ast One corresponding input or output. 


Another method could be used to determine the degree of control- 
lability and observability for a MIMO system and that is the rank meth- 


od. If one forms the matrices 


[p. 0A. ASEM... oa 


and 


and their rank is equal to the order of the system, then the system is 
both controllable and observable. If the rank is less than the order of 
the system, then that difference is the number of uncontrollable and 
unobservable states [ll]. Appendix F contains the eigenvalues (exclud- 
ing augmentation) and the corresponding eigenvector matrix, TEMP. The 
matrix A is the diagonalized modal domain matrix with the eigenvalues 
located along the main diagonal. The new B and c matrices are also 
included and one can observe that no zeroes exist in either matrix. 

Thus one can conclude that control inputs Dl, D2, and D3 can each con- 
trol all the states of the plant while the entire state vector can be 


observed by any of the r, $, and 6 outputs. 
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SB.) System Augmentation 


Before setting off to design a compensator for the control sys- 


tem, one must examine the behavior of the plant singular values. 


Pe 


ure 1l shows the open loop singular values with the system augmented 


with an integrator for each input. 


model, one must take into account the actuator dynamics. 


In order to further improve the 


Actuators are 


normally modeled as second order systems, however, when one takes into 


account the high damping in a real actuator, one can then approximate 


the dynamics of the actuator as a first order system. 


situation looks like Figure 10. 


Pictorially this 


The state-space equations for this open loop representation are: 


x 
—?P 


Ax 


73 


= 


2 it) 


es 


54 


(see 


C3.) 


(378) 


C357) 


(3.18) 


ae) 





Combining the above and putting into matrix form, one gets 


x A BC Oo lfx 01fu 
—Pp pa —Pp 
x = x = 0 A Bac x +104} u 
= ~a2l ac —a—I} |—a —a 
a ne Sane HE 
x 
et 
ye = [C 0 0] 2s 
= 


The modeling of each actuator to a first order approximation will 


be of the form 





ik - xo 
CG. _ =e a i = 1 = i G3. 20) 
Sat i 
T 
Therefore 
A u 


In state space form, this will be represented as 


: x 
Presa: Gwe 
v 


ale 


xX = 


55 








For a system with three control surfaces, in matrix form, we get 


i 1 
= 0 0 = 0 0 
| _ pe z 1 
A, ) - 0 Br 0 a 0 
1 1 
0 -— = 
0 T | 0 0 2 
i 0 0 
Cc, = {0 0 
0 0 IL 


The addition of three integrators is needed to provide high 
enough gains at low frequencies for good command following and disturb- 


ance rejection. 


x 
1 IL 
= = = ae 
Gy - ra CRS), 
Thus for each control variable XS = u Or x =u. Then for a system 


with three control inputs, the associated matrices will look like 


0 
ea Te 
om 1 
peed 20 
ce 0) ee ee 
eon eel 
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The. augmented system in state-space form is consequently given by 


=p(8 x 8) Spa " 2 
(8 x 3)(3 x 3) (8 x 3) (8 x 3) 
me l 
z 0 0 = 0 0 
° l 1 
x = 0 0 Fie 40 0 = O|}x + 0 u 
(3 x 8) . (3 x 3) 
ar er ee 
a iE 
0 0 l Oo oO 
0 0 0 0 0 0 
oe 3 
( ) (3 x 3) 3 7 en 
(3.24) 
(eos On 0’ 0 tL 0. 46 
veo 0 0 0 0 0 1 O 0 Oo |x 
(35x53) Cx 3) 


Note that the cy matrix was not included in the output matrix because 


the desired outputs are r, ¢, and 8. 


The time constant, tT, is defined as oy 2). Recall that the 
projected crossover frequency is about 0.l ee per second so as to 
avoid the natural frequency of ocean waves of 0.14 radians per second. 

A typical value for the natural frequency and damping ratio for an actu- 
ator is 3.14 radians per second and § = 0.9. The resultant time con- 
stant for the actuator then becomes 0.354 sec. This is clearly above 
the desired bandwidth. It was consequently decided to ignore the actu- 
ators and instead use lag compensation at 0.1 radians per second to 
improve roll-off near crossover. This will have the effect of making 
the vehicle less susceptible to modeling errors and high frequency 


noise. Therefore, the system is augmented with three lag compensators 


whose dynamics are as shown in Figure l2. 
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Figure 12. First order lag compensator. 
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3.4 Controller Design 


The method employed to design the controller uses the Model-Based 
Compensator approach [13]. Two very important points must be kept in 
mind. First, the controller must be able to maintain the stability of 
the closed loop system and, secondly, be able to achieve desirable sin- 
gular value loop shapes, in the frequency domain which translate to 
performance specifications. This can be achieved by appropriately shap- 
ing the system singular values in a manner analogous to the single in- 
put-single output Bode plot shaping. Pictorially, the controller and 
system look like Figure 13. Figure 14 illustrates the state-space de- 
scription of the Model-Based Compensator, K(s), and the open-loop plant, 
G(s). It should be noted that the A, B, and C matrices that appear in 
Ei plant also appear in K(s) in a similar fashion and thus the term 


"model-based." 





Figure 13. Feedback structure of a MIMO control system. 


The dynamics of the open loop plant can be written as 


x(t) Ax(t) + Bu(t) + Ld(t) @.25) 


y(t) Cx(t) (3.26) 


The open-loop transfer matrix is then 


ene Gime )ees (3.27) 
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se that 


y(s) = Gp(s)u(s) (3.28) 


The Model Based Compensator dynamics utilizes the state vector ace) 
which has the same dimension as the plant state x(t). The dynamics of 


the MBC can be written as 


z(t) = Az(t) + Bu(t) + Hv(t) G29) 
Pees ne) = Cz (0) ye) = €z(t) nt) G20) 
eS ee cz CC) (3.31) 


In the above, the augmented dynamics of the plant as described by 


Eq. (3.24) are used. Combining the above three expressions we get 
z(t) = [A - BG - HC]z(t) - He(t) (3.32) 


Thus the input to the controller is the error, e(t) and the output is 


u(t). The input-to-output relation can be written as 

u(s) = K(s)e(s) (3.33) 
mere K{(s) — G(si - A + BG + HC) ‘H. If one uses an appropriate change 
of variable, one can determine the stabilizing nature of the gain ma- 
trices G and H. The appropriate variable change is 


w(t) = x(t) - z(t) (3.34) 


It follows that w(t) = x(t) - BG, After making the appropriate sub- 


stitution for x(t) and z(t), one is left with 
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w(t) = [A - HC]w(t) + Ld(t) - Hr(t) (3.35) 


This resulted in the decoupling of the dynamics of w(t) from that of 


x(t). Then x(t) can be written as 


x(t) = [A - BG]x(t) - BGw(t) + Ld(t) (3.36) 


The dynamics of the closed-loop system in matrix form is then given by 


CI): Ee Same Ca x) |e ON fee) 

w(t)} | O A HC|fw(e)} | -H If x(t) 
The eigenvalues of the closed loop matrices [A - BG] and [A - HC] con- 
stitute the system poles. Therefore, the det CALA ore BiG) wand 


det (AI - A + HC) provide the needed insight into the stability of the 


closed-loop system. In order for the closed-loop system to be stable 


Red [A - BG lee. 0; t= 1 2 eee G7) 


and 


Red [A - HE _20r 1 = te 1) ee, 


If we are given matrices A, B and C with [A, B] stabilizable and [A, C] 
detectable, then matrices G and H exist that stabilize the open loop 
system, i.e. [A - HC] and [A - BG] are stable. The methodology used to 
calculate G and H is outlined in sections 3.5 and 3.6 [13, 14]. This 
provides in fact the underlying mathematical basis of the LQG/LTR ob- 


tained solutions. 
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8.5 The Filter Gain and Control Gain Matrices 


It can be seen from Figure 14 that the filter and control gain 
matrices are the heart of the MBC. In essence the Kalman filter gain 
Matrix, H, is the input matrix into the MBC taking the error input 
through the MBC dynamics, which in turm passes it through the integrator 
having first multiplied the outputs by the appropriate gain matrix G. 


This then generates the appropriate control input for the plant. 


The G and H matrices serve a very useful purpose. Recall from 
Section 3.1 that the desired plant output is modeled via singular val- 
ues. Setting the shape of the desired plant open loop singular values 
is important for good command following, disturbance and noise rejec- 
tion. Once the designer has achieved a shape that meets the open loop 
specifications, it is important to realize them next in a closed loop 
configuration. The feedback configuration has the advantages of reduced 
sensitivity to external disturbances, as a result of a course change— 
for example, depth change, as well as meeting the specifications of good 
command following and other noise and modeling uncertainty reduction. 
Through the clever iterative selection of the H and G matrices via the 
LQG/LTR procedure this can be attained. Section 3.6 will detail how 


mans selection is made. 


B.6 Loop Shaping 

This section will outline the procedure that was followed in 
designing the LQG-based controller with Loop Transfer Recovery [14]. A 
plot of the open loop singular values of C(SI - A) ‘B is given in Fig- 
ure ll. Since there are three controls and three outputs, there are 
three lines of singular values. As one can see, there is significant 
separation between the maximum and minimum singular values. It is de- 
sirable that all three behave as close as possible in a tight controller 


design. 
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The first step is to shape the open loop plant singular values so 
they meet the desired specifications of good command following, stabil- 
ity and performance, as well as noise and disturbance rejection. This 
is done by tying the maximum, middle, and minimum singular values to- 
gether at high and low frequencies. To achieve this, one must form the 


matrix 


_ =I 
Geo (8) = C(SL- ADL (3.38) 


where L is an arbitrary matrix that can be manipulated by the designer 


to ultimately give the desired loop shaping. For system at hand, we 


form , 
oi A,) ~BY 
(SI - A) = 
0 st 
where 
A BOC 
ao — pd 
(8 x 8) (8 x 3) 
i = - 0 0 
; (3 x 3) 
ox 1 
0 a 0 
r 
0 0 _ y 
i 
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and 


Q 
(Srx 3) 
eS 0 0 
c 
Dew 
=a 
0 a 0 
T 
0 0 ES 
Ee 


Note, the A matrix of (SI - A) came from Section 3.3. The inverse of 


(SI - A) is 


(SI- A)” = 


The L matrix can be broken up into two components L) and L, where 


z 
Ly Lig x 3) and L, - Li, eae For low frequency shaping, SI is 
approximately zero. With that approximation and forming Grot tS)» one 
gets 
I) 
ae =a 
5 = ees 
= = a0 
ee) tee 1 Ol 7 i (3.39) 
0 = =e 
> 


where C is a (3 x 11) matrix with identity in positions (1, 6), (2, 7), 
and (3, 8) corresponding to the states to be controlled r, 9, and 0. 


Expanding (3.39) yields 
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Caressa 
-1 -| —|] |j—* =*2 
fo) oP ky ee (3.40) 


But for small s, low frequency, the second term in (3.40) dominates the 


-1 
| -1 | eee 
first term. So C(SI - A) L can be approximated by ——_— Then 
to tie the singular values together at low frequencies we also have 
i 

Geoz 68? =>: Therefore 
L, = =(C,,A, B,) G.4) 
2 —ll-—* —* , 


For high frequencies, one can approximate (SI - A) by SI. Using 


the same procedure as above, 





- 23x we 
(ST) zo SD 
c(sl - A) L = [ce ;, ow a (3.42) 
0 Fe 2 
= 5 
Expansion of (3.42) yields 
CEL Cb ek 
- —l1— —11—*—2 
(Sl - A) L = Lap (3.43) 


As S gets large, high frequencies, the second term in (3.43) will be 


dominated by the first term. So L, will be equal to 


1 


mee =i a i r 
Lb, = fear) ee ee re) 
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The combination of re and L, now constitutes the L matrix of the 
overall system. The L matrix provides loop shaping and is totally under 
the designer's control as a free design parameter. Figure 15 shows the 
result of the initial open loop shaping. This, in turn, provides the 
desirable system profile which the closed loop compensated system should 
match. The resulting L matrix can be found in Appendix G. In order for 
the crossover frequency to be less than the critical crossover frequency 
of 0.1 radians per second, (natural sea spectrum is at 0.14 radians per 


second), it was necessary to multiply the L matrix by a scalar of 0.05. 
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Figure 15. Singular values of G (jw). 
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The next step in the controller design is to determine the filter 
gain matrix, H. To do this one solves the Filter Algebraic Riccati 


Equation (FARE). 
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Q = SA+A‘E + 


l x 
- = 2c"e ‘cx (3.45) 


| tz) 


where © is an arbitrary (m < m) symmetric and positive definite matrix 


(equal to the identity here) and =, normally the process noise covari- 


— 
—— 


ance matrix is now replaced by LL. The solution to the FARE is the 


(n xX n)z= matrix. The filter gain matrix is given by, 


l T_-l 
Ho aes SC 2 (3.46) 
i oe 
If one plots the singular values of the Kalman filter, 
, -l 
o.(Gep(jw)) = C(Sl- A) H (3.47) 
then they should pattern the profile of the singular values of Gio, (iv) - 


Figure 16 shows the similar profile. The DC gains, crossover frequency, 
and band crossover bandwidth are approximately the same. If it becomes 
necessary to adjust the DC gain and crossover, this can be accomplished 


by selecting another free parameter u, in Eqs. (3.45) and (3.46). 


The final step in the controller design is to solve the Control 
Algebraic Riccati Equation (CARE) to obtain the control gain matrix, G. 


The CARE looks like 


0 = -KA - A’K - qQ + KBR BK (3.48) 


where K is an (n x n) solution. The R matrix is an (m <X m) positive 
definite matrix (identity for our purposes), and the Q matrix is given 


by 
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Figure 16. Singular values 


such that [A, C] is a detectable pair. The 


given by 


G6 = R BK 


The singular values of the resultant 


(o (TG) ]) are now calculated where 


T(s) G(s)K 


LQG 


Or 


T(s) Gp(s)K(s) 
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(s 


of Gj). 


control gain matrix G is 


(3.50) 

loop transfer matrix 
) (3.5la) 
(32515) 





G(s) is the plant transfer matrix defined by 
G(s) = Gp(s)Ga(s) (3.52) 


as illustrated in Figure'7. In the frequency domain Koc’ is given 


by: 


K ac! Ges — A eeGet HC) “H G255) 


Figure 17 is a plot of the singular values of the compensated system 
T(s). A value of 1000 was used for q so that the three individual con- 
trol singular values coincide. It is apparent by comparing 0, (L(jw)) 
with 0; (CG. G4)) that the DC gains are equal and crossover occurs at the 
same frequency. The roll-off past crossover is desired as illustrated 


ia@erigure 9. 


A check was made to determine if the controller, K(s) introduced 
any instabilities into the system. Table 2 is a listing of poles and 
zeroes which indeed corroborates the fact that the design has resulted 
aya Stable system. Appendix H contains the A, B, C, G, H and 
(A - BG - HC) design matrices that will also be used in the simulation 


as described in Section 4.1. 
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Table 2. 


Number 
i -4 
2 alt 
3 al 
5 cal 
7 =o 
8 ae 
10 -o 
ie -4 
14 =1 
Number 
1 -2 
2 -4 
3 =o 
4 =] 
6 — II 
7 eat 
8 = 
9 -6 
11 =. 


Unique Poles 


Real 


-421317785E-02 
-984642130E-01 
ela oOs IROL 
»-283572447E-01 
nz 2686 (Ol 
75527 DECOR -OF 
-470467465E-01 
. 856380807E-01 
e202 2170 OE TUe 


Unique Zeroes 


-418544925E-02 
. 3429400 86E-02 
pee I00E-—O2 
POeZ2oo 99 lGE—OL 
247 lo24363E-01 
. 85278886 9E-01 
Pee Woo EO | 
.230977444E-01 
- 179401036E-01 
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Sa) 


4 


Poles and zeroes of K(s). 


-689624484E-01 
.200466481E-01 


.140172344E-01 
a2 2 ES 2OFSE00 
-654424752E-01 


=7.231643907E-02 
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CHAPTER 4 


COMPENSATOR PERFORMANCE 


Cee]. Model Simulation 


The model simulation used to test the controller involves the 


integration of 
z(t) = (A - BG - HC)z(t) - He(t) 
where e(t) is the error vector defined by 
CNGE) een Cb) = y (bE) 


To close the loop, one can either select the linear model or nonlinear 
model as developed in Chapter 2. It is expected that the linear model 
will give good results with the nonlinear model giving acceptable re- 
sults because the controller was designed from the linear model origin- 


ally. 


4,2 Simulation Results 


Now that the controller has been designed, it is necessary to 
test its performance. Recall that the motivation behind this thesis was 
twofold: (i) design a controller from a linear model and (ii) test it 


on a nonlinear model, controlling r, $6, and 9 in a turn. 


2 





The first test simulation run purpose was to check if the con- 
troller would be able to achieve zero steady state error with a command 
reference input of -0.368482E-02 rad/s, the nominal r value, and zero 
for both $¢ and 8, keeping in mind that the open loop roll for the same 
condition was 1.5 degrees and 8 4.0 x ome degrees. With the closed 


loop simulation, both $9 and 86 indeed went to zero. 


A second simulation run was made to command a condition that was 
other than the nominal r. A turning velocity equivalent to a 5 degree 
nominal rudder deflection was commanded with zero again for 9 and @. 
The open loop ¢ and 6 for this condition were 5.5 degrees and 2.5 de- 
grees respectively with the controller, r went to the commanded value of 
-Q0.1160E-02 rad/s, and $ and § went to zero. With both simulation runs, 
the controller achieved zero steady state error for the three command 
inputs. Figure 18 contains the open loop r, ¢ and 9 response runs and 
the closed loop simulation response with command input of -0.368482E-02 
rad/s, 0°, and O° for r, ¢ and 6 respectively. Figure 19 likewise shows 
the open and closed loop responses for r = -0.1160E-01 rad/s and zero 


for > and 6. 


One additional benefit of the controller can be seen with depth, 
z. Without the controller, both open loop simulations exhibited contin- 
uous depth change throughout the run. With the controller, the vehicle 
sank a small amount but steadied as the run continued. Therefore the 
controller was able to stabilize depth loss even though depth was not a 


GConero!l variable. 
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Figure 18. Open and closed loop simulation responses with 
command input. 
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CLOSED LOOP SIMULATION RESPONSE (2° RUDDER) 
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CLOSED LOOP SIMULATION RESPONSE (CONT'D) 
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Figure 19. Open and closed loop simulation responses with 
command input. 
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CLOSED LOOP SIMULATION RESPONSE (5° RUDDER) 
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CLOSED LOOP SIMULATION RESPONSE (CONT'D) 
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CHAPTER 5 


CONCLUSIONS AND RECOMMENDATIONS 


The LQG/LTR method can be successfully used to design a control- 
ler from a linear model. Additionally the resulting controller is able 
to perform acceptably with zero steady state error on a nonlinear model, 


which more closely approximates the real world system. 


The MDS configuration has demonstrated improved ability over the 
conventional cruciform stern in turning situations. With the ability of 
the vehicle to align its local reference axis to that of the global 
system, one is able to obtain true motions of surge, sway, heave, roll, 
pitch, and yaw. The advantage being improved crew comfort and quicker 


computer solutions to fire control problems. 


It is recommended that further thesis work on this model to in- 
clude depth control with the additional control surface of sailplanes. 
A potpourri of operating points spanning a speed range from 5 to 2l 
knots with rudder deflections of 5 to 30 degrees will give on a feeling 
for the capabilities of the MDS configured submersible. The addition of 
vortex shedding to the model will also improve the characteristics of 
the model to real world submersibles. Finally, it would be desirable to 
design a controller that could negotiate ordered changes in depth. With 
gain scheduling, the model could clearly be used as a training aid in a 


simulation laboratory. 
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APPENDIX A 


MASS PROPERTIES 


Mass Weight Buoyancy 
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XB YB ZB 
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Xstern Slength 
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APPENDIX B 


NONLINEAR EQUATIONS OF MOTION 


Axial Force Equation 
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Lateral Force Equation 
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Normal Force Equation 
mw — mx.4 a my,P = 
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7 A ae oF N uo + Ngnu| 


2 
+ A8y[1-5868H) 1 ss4g1741P po ~ 0.6088N))5u,|r,| + 1.5868N,.u D9 
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nO 


2 2 
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2 
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30 
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+ an|N Woy = N ou vy. + N v Wve tw 
roo vn 0'o vi{v{n No Oo 


2 


2 
“(0.793405 


2 
+ Nga u e 0.79340; } 


0 


Z 
7 Nene 19 = 0.6088D,, + 0.60880.) | 


0 
where: 
2 2 
IN Z (w (x) + 2v (x) ] 
CRFW _ pf _,2 ww ae Oe eee Ona 
esr = (+ 7 Dix) mie H (x) 5 ; dx 
Q Q [ve (x) + w(x) 
oN iz 
CRFW of ,2  ww__ v_(x)w_ (x) 
ow _? ( : f D(x) ie NC dx 
& R Jv. Go + we (x) 
oN Zz 
CRFW _ op 2 wwe, 2 v_ (x)w_ (x) 
oq 7 2 (: f Dx) =) J ee ee ee dx 
& R Iv (x) + we (x) 
2 2 
dr 2 f D(x) dx 9 9 
Q Q v5) + wo (x) 
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APPENDIX D 


SUMMARY OF NON-DIMENSIONALIZING FACTORS AND 
DIMENSIONALIZED HYDRODYNAMIC COEFFICIENTS 











Dimensionless Form 
te 
' —_ 
a a g> 
9 p 
It 
Ih: = Sac 
Toe 
9 p 
te 
' = 
_ Be g> 
9 p 
Je 
I = — 
il 5 
ee 
I 
ti = —J2_ 
i 
1é 
: - ZX 
iI 5 
2x = af 
Ky 
Ki = 
x 
> on-U" 


NOTATION [1] 
Definition 
Moment of inertia of submarine about 


x axis 


Moment of inertia of submarine about 
y axis 


Moment of inertia of submarine about 
Z axis 


Product of inertia about xy axis 


Product of inertia about yz axes 


Product of inertia about zx axes 


Rolling moment when body angle (a, 8) and 
control surface angles are zero 
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NOTATION (Cont, ) 


Symbol Dimensionless Form 


Definition 
K 
' = #1 pale : 
Ren Ren aera 32 Coefficient used in representing K, as a 
5 Px U function of (n-1l) 


First order coefficient used in represent- 
ing K as a function of p 


Coefficient used in representing K as a 
function of p 


Second order coefficient used in repre- 
senting K as a function of p 








7G ae = es Coefficient used in representing K as a 
mene function of the product pq 
s i 
Sc ar = a 5 Coefficient used in representing K as a 
q 5 OX function of the product qr 
S 
K. K. = i First order coefficient used in represent- 
> PR U ing K as a function of r 
Ke 
Ks Ke aaa 5 Coefficient used in representing K as a 
7 Pe EuNetion sof E 
KY 
K K' = 
Vv Vv = 27 


First order coefficient used in represent- 
ing K as a function of v 


tie 





Symbol 


“v|v| 


K 
vq 


Dimensionless Form 
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Sy die g4 
9 p 
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: vi v| 
K 
K = pene 
vq ok ne 
9 p 
Soe 
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ae AL 9? 
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K! EP 
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9 0 
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ae 7 A ae 
7 p 
K 
Ks = ae 
SZ 
7 o£ U 
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9 p 
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oF 
= phour 


NOTATION (Cont. ) 


Definition 


Coefficient used in representing K as a 
function of v 


Second order coefficient used in repre- 
senting K as a function of v 


Coefficient used in representing K as a 
function of the product vq 


Coefficient used in representing K as a 
function of the product vw 


Coefficient used in representing K as a 
function of the product wp 


Coefficient used in representing K as a 
function of the product wr 


First order coefficient used in represent- 
ing K as a function of on 


Overall length of submarine 


Mass of submarine, including water in 
free-flooding spaces 


Pitching moment when body angles (a, 8) 
and control surface angles are zero 
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symbol 


M 
p|p| 


M 
qalq| 


M 
lq|é 


rp 


"e|r| 


ME 


M 
viv 


Dimensionless Form 


M! 
p|p| 


M 
_plpl 
ae 
a 





NOTATION (Cont. ) 


Definition 


Second order coefficient used in repre- 
senting M as a function of p. First order 
coefficient is zero. 


First order coefficient used in represent- 
ing M as a function of q 


Coefficient used in representing M as a 
function of q 


Second order coefficient used in repre- 


senting M as a function of q 


Coefficient used in representing M 
function q 


as a 
6 


Coefficient used in representing M as a 
function of the product rp 


Second order coefficient used in repre- 
senting M as a function of r. First order 
coefficient is zero 


Coefficient used in representing M as a 
function of the product vr 


Second order coefficient used in repre- 
senting M as a function of v 
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Symbol 


lw 


“\wlq 
*a| w! 


M 
ele 


ob 


Dimensionless Form 





a 
M' = 
i. = 27U 
ve 
’ — 
i 3 
5 2 U 
a! = 
7 1 4 
pee 
a WwW 
le ~ Tt 4 
eee 
M 
on ~lwla 
|wlq ee 
pe 
M 
: _ _wiwl 
w| w| il 5 
pe 
M 
M! 2 wiw|n 
wlw|n i 2 
ae 
ee 
Sb iGesekc ae 
7 o2 U 
M 
M! : 
é ar, 


NOTATION (Cont. ) 


Definition 


First order coefficient used in represent- 


ing M as a function of w 


First order coefficient used in represent- 


ing M as a function of (n - 1) 


Coefficient used in representing M as a 
function of w 


First order coefficient used in represent- 


ing M as a function of w; equal to zero 
for symmetrical function 


Coefficient used in representing a as a 
function of w 


Second order coefficient used in repre- 
senting M as a function of w 


First order coefficient used in represent- 


ing M asra. function, Of (y = 1) 
wl w| 


First 


ing M as a function of 6 


b 


First 


ing M as a function of 6 


Zo 


order coefficient used in represent- 


order coefficient used in represent- 





NOTATION (Cont. ) 








Symbol Dimensionless Form Definition 
Bs 
M M! = First order coefficient used in represent- 
én én l Sez : 
zy PL U ing M. as a function of (n - 1) 
Ny 
Ny N, = 7 2m Yawing moment when body angles (a, 8) and 
3 e% U control surface angles are zero 
N 
N N' = 7s First order coefficient used in represent- 
P > ek U ing N as a function of p 
Ne 
N Nei = Roe Coefficient used in representing N as a 
P P =z 02 function of p 
N 
N N' = ae Coefficient used in representing N as a 
Pq Pq z P% function of the product pq 
S r 
Nor N! a 4 5 Coefficient used in representing N as a 
q aS > od of the product qr 
N 
N N' = 7 First order coefficient used in represent- 
, . > 02 U ing N as a function of r 
N 
N N! = can First order coefficient used in represent- 
a a =z Ok U ing N.. asso tune tion or. (1) — 2) 
Ne 
N° Ne' = 1 =e Coefficient used in representing N as a 
: > ef funetion of © 
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Symbol 


Nelr| 


Ne lor 


N 
vr) 


vq 


“| ylx 


Ny |v 


N 
vi[v|n 


Dimensionless Form 





t 
Ne [x eS 
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N? SI rior 
|r |Sxr Lee 
nN 
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5 Oe 
Non 
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al = p27U 
me 
at i 
a i 4 
pee 
NY 
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I 4 
vq = pt 


Nt Z ‘ivlx 


lvir = on" 
aka 

' — 

v|v| Cs, 
ieee 

N 
! ViVvin 
vi[v|n + on 


NOTATION (Cont.) 


Definition 


Second order coefficient used in repre- 
senting N as a function of r 


Coefficient used in representing N 
Dunc Elon Of «1 


as’ a 
Or 


First order coefficient used in represent- 
ing N as a function of v 


First order coefficient used in represent- 
ing NY as a function of (n - 1) 


Coefficient used in representing N as a 


function of v 


Coefficient used in representing N as a 
function of the product vq 


Coefficient used in representing N. as a 
function of v 


Second order coefficient used in repre- 
senting N as a function of v 


First order coefficient used in represent-— 
ing ee as a function of (nj - 1) 
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Symbol 


6r 


érn 


NOTATION (Cont. ) 


Dimensionless Form 








a 
' —_ 
ee i g? 
ee 
N 
N! - —_“p_ 
Lea 
7 © 
er 
’ — 
N T J 
7? 
N! _ Nor 
6r l sy 
9 o2 U 
' 7 Neen 
6rn iL gy" 
2 
r — Pd 
P U 
p! = ae 
y2 
r = Qh 
4 U 
a 
*, _ Gh 
q —" 9 
U 
ee re 
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Definition 


Coefficient used in representing N as a 
function of the product vw 


Coefficient used in representing N as a 
function of the product wp 


Coefficient used in representing N as a 
function of the product wr 


First order coefficient used in represent- 
ing N as a function of 6. 


First order coefficient used in represent- 
ing Noe as a function of (mn - 1) 


Angular velocity component about x axis 
Felativerto Eluid (roll) 


Angular acceleration component about x 
axis relative to fluid 


Angular velocity component about y axis 
relative to fluid (pitch) 


Angular acceleration component about 
y axis relative to fluid 


Angular velocity component about z axis 
relative to fluid (yaw) 
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NOTATION (Cont.) 


1 


Symbol Dimensionless Form Definition 
s 2 
° oF _ r2Z . 
ane Angular acceleration component about 
U Z axis relative to fluid 
U , . ie 
U U = a Linear velocity of origin of body axes 
relative to fluid 
u 
u u' = v Component of U in direction of the x axis 
: “4 ul 3 , : 
u u ao) Time rate of change of u in direction of 
U the x axis 
Uo 
u, ue aece Command speed: steady value of ahead 
speed component u for a given propeller 
rpm when body angles (a, 8) and control 
surface angles are zero. Sign changes 
with propeller reversal. 
Vv vi = a Component of U in direction of the y axis 
Vv vi = ~ Time rate of change of v in direction of 
U the y axis 
W wi = a Component of U in direction of the z axis 
Ww w' = Time rate of change of w in direction of 
U the z axis 
x x' = a Longitudinal body axis; also the coordi- 


nate of a point relative to the origin of 
body axes 


The x coordinate of CB 


=| J 
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Symbol 


X 
qq 


X 
rp 


EE 


uu 


VE 


Dimensionless Form 


me 
qq 


x! 


xt 
5a © 


ey 
uu 


> a 
vr 


VV 














hole 





hol 
DO 
x 


NOTATION (Cont. ) 


Definition 


The x coordinate of CG 


A coordinate of the displacement of CG 
relative to the origin of a set of fixed 
axes 


second order coefficient used in repre- 
senting X as a function of q. First order 
coefficient is zero 


Coefficient used in representing X as a 
function of the product rp 


Second order coefficient used in repre- 
senting X as a function of r. First order 
coefficient is zero. 


Coefficient used in representing X as a 
function of u 


Second order coefficient used in repre- 
senting X as a function of u in the non- 
propelled case. First order coefficient 
is zero. 


Coefficient used in representing X as a 
function of the product vr 


Second order coefficient used in repre- 
senting X as a function of v. First order 
coefficient is zero. 
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Symbol 


vvn 


X 
wq 


SEBS D 


Se 


ea 


a yeae 


ysis 


NOTATION (Cont. ) 


Dimensionless Form 








it 
’ — 
aan l 2 
pee 
Xx 
' eee wl 
il 3 
wq = of 
ae 
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aT 1 Z 
pee 
an 
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AWM 1 Ji 
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Definition 


First order coefficient used in represent- 
ing xX as a function of (y - 1) 


Coefficient used in representing X as a 
function of the product wa 


Second order coefficient used in repre- 
senting X as a function of w. First order 
coefficient is zero 


First order coefficient used in represent- 
ing X as a function of (n - 1) 


Second order coefficient used in repre- 
senting X as a function of 6,. First 
order coefficient is Zero. 


Second order coefficient used in repre- 
senting X as a function of 6 First 
order coefficient is zero. 


First order coefficient used in represent- 


: : A 
ing X, 5, as a function of (n ) 


Second order coefficient used in repre- 
senting X as a function of 6 First 
order coefficient is zero. 


First order coefficient used in represent-— 


ing Xe 58s as a function of (n - 1) 
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Symbol 


Y 
p|p| 


Pq 


Dimensionless Form 


a 2. 
y g 
m8 
YR Q 
1 _ 2G 
4G Q 
wes. vO 
Yo Q 
Y 
yi = 
ae 
5 o2 U 
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Sate gee 
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NOTATION (Cont.) 


Definition 


Lateral body axis; also the coordinate of 
a point relative to the origin of body 
axes 


The y coordinate of CB 


The y coordinate of CG 


A coordinate of the displacement of CG 
relative to the origin of a set of fixed 
axes 


Lateral force when body angles (a, 8) and 
control surface angles are zero 


First order coefficient used in represent- 
ing Y as a function of p 


Coefficient used in representing Y as a 
function of p 


Second order coefficient used in repre- 
senting Y as a function of p 


Coefficient used in representing Y as a 
function of the product pq 


ay 





NOTATION (Cont. ) 











Symbol Dimensionless Form Definition 
Ze Er 
we ae = as Coefficient used in representing Y as a 
7 Pk function of the product qr 
YL Y oo First order coefficient used in represent- 
> p2°-U ing Y as a function of r 
ee 
ee ee - TS First order coefficient used in represent- 
5 Pz U ing a as a function of (n - 1) 
rr 
xe Ye! eo Seer, Coefficient used in representing Y as a 
7 Pf function of r 
! "lel 6x 
ye x Coefficient used in representing Y as a 
|r| ér lr|ér ie. 3S or 
3 Pk U AUNCELOM Of iG 
= 
NG y' = First order coefficient used in represent- 
Vv l 2 : : 
7 9% U ing Y as a function of v 
Me 
x E a . First order coefficient used in represent- 
n n = pg U ing Yas a function of (n - 1) 
Ye 
Ye ica = “ Coefficient used in representing Y as a 
Vv V iL 3 : : 
> PS Funetion Of Vv 
x : 4 oe Coefficient used in representing Y as a 
at vd > PX function of the product vq 
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Symbol 
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Y. 
viv[n 
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é6rn 


Dimensionless Form 
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Tyr a > 
9 0 
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vi|v{n ik 92 
9 0 
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NOTATION (Cont.) 


Definition 


Coefficient used in representing Y asa 
function of r . 


Second order coefficient used in repre- 
senting Y as a function of v 


First order coefficient used in represent- 
ana as af Eronno ft _ 
g vv! Ss uncti (n 1) 


Coefficient used in representing Y as a 
function of the product vw 


Coefficient used in representing Y as a 
function of the product wp 


Coefficient used in representing Y as a 
function of the product wr 


First order coefficient used in represent- 
ing Y as a function of Or 


First order coefficient used in presenting 


Y ey as a function of (n - 1) 


Normal body axis; also the coordinate of a 
point relative to the origin of body axes 
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Symbol 


“p |p| 
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Dimensionless Form 
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NOTATION (Cont. ) 


Definition 


The z coordinate of CB 


ine Zs coordinate of CG 


A coordinate of the displacement of CG 
relative to the origin of a set of fixed 
axes 


Normal force when body angles (a, 8) and 
control surface angles are zero 


Second order coefficient used in repre- 
senting Z as a function of p. First order 
coefficient is zero 


First order coefficient used in represent- 
ing Z as a function of q 


Coefficient used in representing Z as a 
function of qg 


Coefficient used in representing Ze as a 
tunetionsor q 


Coefficient used in representing Z asa 
function of the product rp 
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Symbol 
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qXy 


wT) 


“|| 


Zz 
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Z 
wlw|n 


Dimensionless Form 
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q Zz PLU 
ZL 
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5 Pe U 
ae 
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NOTATION (Cont. ) 


Definition 


Second order coefficient used in repre- 
senting Z as a function of r. First order 
coefficient is zero 


First order coefficient used in represent- 
ing Z as a function of w 


First order coefficient used in represent- 
ing = as a function of (n - 1) 


First order coefficient used in represent- 
ing Z as a function of (n - 1) 


Coefficient used in representing Z as a 
function of w 


First order coefficient used in represent- 
ing Z as a function of w; equal to zero 
for symmetrical function 


Coefficient used in representing Z as a 
function Of q 


Second order coefficient used in repre- 
senting Z as a function of w 


First order coefficient used in represent- 
Ing. 2 as a function of (n - 1) 
w|w| 


1S 





NOTATION (Cont. ) 





Symbol Dimensionless Form Definition 
ne 
Zi. zg = Gy 5 second order coefficient used in repre- 
7 9% senting Z as a function of w; equal to 


zero for symmetrical function 


ie 
6b 
Zs Zen =e | See First order coefficient used in represent- 
3 o2 U ing Z as a function of 5, 
ay 
Ze Ze eo: First order coefficient used in represent- 
> of U ing Z as a function of 6. 
aoe 
an ee = a First order coefficient used in represent- 
5 Oo U ing Ze as a function of (n - 1) 
81, Deflection of bowplane or sailplane 
Se Deflection of rudder 
S Deflection of sternplane 
“ec 
n The ratio —- = u' 
U c 
8 Angle of pitch 
w Angle of yaw 
> Angle of roll 
dean De Cy Sets of constants used in the representa- 
a . tion of propeller thrust in the axial 


equation 


SZ 





Axial Coefficients 


XQQ XRR XRP XUDOT 
-138568. -11547. 54588. -1819.584 
XVR XWQ XUU XVV 
63161. -58728. 0 154.872 
XWW XDD XVVN XWWN 
120.204 -188.02 0 0 

XDDN XDBDB 
0 -~91.044 


Lateral Coefficients 


YRDOT YPDOT YPABP YOR 
-39890. -72433. 0 0 
YVDOT YVQ YWP YWR 
-79122. 0 58728. 0 
YR YP YABRD YVABR 
41705. -4549, 0 0 
YSTAR YV YVABV YVW 
0 -1043.  -2054.2 0 
YD YRN YVN YVABVN 
185 .036 0 0 0 
YDN YPQ 


seer L 138568. 
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Normal Coefficients 


ZQDOT ZPABP ZRABR ZRP 
-170000. 0 0 0 
ZWDOT ZVR ZVP ZO 
-69459. 0 -33067.  -42148. 
ZABQDD ZWABQ  ZSTAR ZW 
0 0 0 -1044.3 
ZWABW ZABW ZVABV ZD 
0 -8.97 0 248.054 
ZQN ZWN Ss ZWABWN ZDN 
0 0 0 31.34 
ZDB ZABQD ZWW 
-175.90 0 15.99 


KPDOT 
=1133000. 


KPABP 
0 


KVQ 
0 


KV 
-3423. 


KSTARN 
0 


KRDOT 
oo 


KP 
= 153265". 


KWP 
5o2aar 


KVABV 
0 


K4S 
1281.4 
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Rolling Coefficients 


KOR 
-2796560. 


KR 
-398900. 


KWR 
0 


KVW 
0 


K8S 


KVDOT 
oy 407 


KSTAR 


i56c- 





MQDOT 


-124300000. 


MQABQ 
0 


MQ 
-4066000. 


MSTAR 
0 


MVABV 


MDB 
4222. 


NRDOT 
-128800000. 


NRABR 
0 


NVQ 
0 


NABRD 
0 


NVABV 
49980. 


NRN 
0 


NDN 
-4374 


CDCRSS 
- 56889 


Prechine seert tevencs 


MPABP 
0 


MWDOT 


=-./060G" 


MABQDD 
0 


MW 
221602 


MDD 


MWABWN 


MRABR 
0 


MVR 
0 


MABQD 
0 


MWABW 
= 07 oe 


MD 
-23438. 


MDDN 
0 


Yawing Coefficients 


NPDOT 
-434600. 


NVDOT 
-39800. 


NP 
=O2900. 


NABVR 
0 


NVW 
0 


NVN 


iS) 


NPQ 


-97313000. 


NWR 
0 


NR 


-3766000. 


NSTAR 
0 


NDD 


NVABVN 


MRP 
29666000. 


MWW 
lS e556 


MABWQ 
0 


MABW 
-239.72 


MON 
0 


- MDN 
=3053. 


NQR 
0 


NWP 
-138558. 


NABRDD 
0 


NV 
=-1266!. 


ND 
-9798. 


NDDN 





APPENDIX E 


DESCRIPTION OF PROPULSION MODELS AND NOMINAL POINT DETERMINATION 


There are two propulsion models an RPS and an eta propulsion 
model. The RPS model is a first order differential equation in terms of 
RPS (revolutions per second) and is considered the more accurate model 
of the two. The eta propulsion model is a simplified version of the RPS 


model in that it is a first order differential representation where eta 
u 
; ‘ Cc ; ‘ 
(n) is defined as 7° U is the actual speed of the submersible and u, 
is the commanded forward velocity. The eta model is important because 
it was the model that was linearized and included in the linear equa- 


tions of motion. 


In order to find a nominal point, the final values of the states 
(u, V, Ww, P> qs r, phi and theta) from the RPS integration are used as 
an initial point with the eta model integration. The nonlinear equa- 
tions are again integrated, however, using the eta propulsion model. A 
search routine is used to search for a nominal point (a local equilib- 
rium point where the derivatives of the state variables are zero). To 
get some idea how good the nominal point is, the accelerations asso- 
ciated with each of the states are calculated. As a rule of thumb, 
accelerations should be less than ions The equilibrium point for this 


model is listed below. 
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XDOT 
XDOT 
XDOT 
XDOT 
XDOT 
XDOT 
XDOT 
XDOT 


en 


(1) 
(2) 
(3) 
(4) 
(5) 
(6) 
(7) 
(8) 


fe 


< 


Heo) de <x 


phi 
eta 


psi 


DB 
Di 
D2 
D3 


»134572E-10 
. 132110E-07 
. 130859E-08 
27 DO 3h—06 


0.137816E-10 
0. 999896E-10 


-568434E-13 
les 5 1 9E- 10 


Orso ba55Er0z 
0.317284E+00 


Ue 


Oe 


67850 8E-02 


. 368353E-06 


99615 9E-04 


- 368482E-02 


0.154856E+01 
0.572548E-02 
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~211141E+02 
. 170338E+00 
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APPENDIX F 


MODAL ANALYSIS MATRICES 


OBSERVABILITY(T#C) 


“2,1290E-05 7.1583E-05 4.84238-03 5. 2630E-05 3.2220E-03 3.2220E-03 1.3762E-03 -2.7719E-02 
0.0000E+00 O.0000E+00 0.0000E+00 0.0000E+00 6. 9118E-03 -b.9118E-03 0.0000E+00 0.0000E+00 


2,6489E-03 -2.0743E-03 -1.9729E-02 2.41 11E-03 -5.6558E-01 -5. 6558E-01 -6.4347E-03 2.6790E-01 
0.0000E+00 O.0000E+00 0.0000E+00 0.0000E+00 7.0275E-02 -7.0275E-02 0. 0000E+00 0.0000E+00 


“7. B555E-01 1,6809E-03 1,5494E-02 3.5456E-02 1.4757E-03 1.4757E-03 6. 7821E-02 4.3741E-03 
0.0000E+00 O.0000E+00 0.0000E+00 0.0000E+00 S.1573E-04 -3.1573E-04 0.0000E+00 0. 0000E+00 


CONTROLLABILITY (T”! 


+B) 
“1.SS11E-02 2.3498E-01 2. 1431E-01 
“B.0762E-11 7.1922E-11 -7.5965E-11 


4, 2570E-01 -6.0879E-02 7.5270E-02 
1.1603E-10 -9.0817E-11 1.1762E-10 


5. 2682E+00 2.0472E+00 -1. 7453E+00 
=3.6227E-09 2.9746E-09 -3.3771E-09 


1.0539&+00 -7,2540E-02 1.1276E+00 
1.1672E-10 1.16998-10 -7,2679E-11 


3.0824E-01 -1,0009E-01 3.1597E-02 
9, b169E-01 -8.6784E-01 8.5702E-01 


3.0824E-01 -1.0009E-01 3. 1597E-02 
“9, b169E-01 8.6784E-01 -8.3702E-01 


“1.6724E-01 2, 3913E+00 2. 2465E+00 
1.790BE-10 -1.7178E-10 1.6932E-10 


1.5552E+00 -6.7186E-01 4.8629E-01 
“4, A03GE-09 3, 4853E-09 -3. 2005E-09 
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1 


DIAGONAL A MATRIX(T —#A8T) 


-2.0293E-02 -4.B182E-11 7.3209E-10 -4.3965E-10 -2.1759E=10 -2.9193E-10 -7.0223E-09 -4.9357E-09 
G.0822E-15 3.1627E-15 9.9136E-13 2.5088E-14 3. 1149E-09 -3,1450E-09 9. 1370E-13 -4.9420E-12 


-9.8699E-09 -4.3774E-02 -3.8043E-09 9.8277E-10 -b.5464E-08 -6.5325E-08 -3,1495E-09 1.1928E-07 
“J. 7AQLE-14 -1 4MB9E 14 -2.0391E912 5. 7494E=14 6. 3310E-09 -b.3132E-09 -4.2576E-12 1. 2084E-11 


“1.4485E-09 1.4366E-10 -1.8040E-01 S.4190E-10 1.3579&-08 1.0251E-08 -6.1731E-09 -1. 8558E-09 
SeO9S4EW13 2.2166E-13 4.B451E-11 1.5575E-12 -5.4467E-09 4.3286E-09 7. 3613E-11 -1.2185E-10 


“5. 2042E-09 -3.5774E-10 4.4974E-09 -1.8432E-01 1.4152E-08 1.4424E-08 1.0565E-08 -5.5337E-08 
“5. 9672E-14 -6.8722E-14  2.9312E-13 9.8037E-14 7. 0181E-08 -7.0659E-08 -1.3197E-11 -3.9280E-11 


“1, 3921E-09 -3. 2740-10 -1.0737E-09 1.6470E-11 -3.0851E-01 3.4939E-09 §.8439E-10 -1.1038E-09 
“7.2923E-10 -3.5568E-10 1. 7830E-10 1.6758E-10 5.2247E-01 -1.7384E-08 1.8838E-09 1.0024E-08 


“1. 3799E-09 -3.3429E-10 -1.0920E-09 S.6241E-11 -8.2512E-09 -5.0851E-01 S.88B1E-10 3.0062E-09 
7 TASSE-10 3.4266E-10 -1.9646E-10 -1.4578E-10 2.4680E-08 -5.2247E-01 -1.9305E-09 -6.7210E-09 


1, 3967E-09 -4.2439E-10 1.4827E-09 -2.5007E-10 -1.12688-08 -1.1079E-08 -6.2278E-01 2.4002E-08 
A ABOBE-14 -1.5415E-14 -2.1257E-12 4. 2041E-15 -1.8744E-09 1.9342E-09 -b.4594E-13 2.1903E-11 


-B.4933E-09 2.2B54E-10 -8.5856E-09 9.8674E-10 -8.2833E-09 -1.3066E-08 4.4007E-09 -6.5857E-01 
“J.BO94E-13 3.7923E-13 2.6495E-11 <1. 1123E-12 -b.8672E-10 1.11218-09 1.L026E-11 -2.8917E-10 
EIGENVALUES 


=2.0293E-02 -4.3774E-02 -1,8040E-01 -1.8432E-01 -5.0851E-01 -5.0851E-01 -6.2278E-01 -6.5837E-01 
0.0000E+00 0.0000E+00 0.0000E+00 0.0000EH00 5.2247E-01 -5.2247E-01 0.0000E+00 0. 0000E+00 
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EIGENVECTOR (T) 
2 1339E-02 -9.9996E-01 -5.S213E-02 9.0521E-03 2.8894E-03 2.8894E-03 4.3930E-02 2.2700E-02 
O.0000E+00 0.0000E+00 O.0000E+00 0.0000E+00 -1.5787E-03 1.5787E-03 0.0000E+00 0.0000E+00 


1.6640€-02 -B.5246E-03 -9.S374E-01 -6.6859E-03 6.4394E-01 6.4396E-01 3.9225E-02 -9.4647E-01 
0.0000E+00 O.0000E+00 0.0000E+00 0.0000E+00 1.8740E-01 -1.8740E-01 0.0000E+00 0.0000E+00 


6. 1799E-01 -2.7814E-03 -3.SS12E-01 -9.9935E-01 1.6231E-01 1.6231E-01 9.9503E-01 4. 2817E-04 
0.0000E+00 0.0000E+00 0.0000E+00 0.0000E+00 7.5758E-03 -7.5758E-03 0.0000E+00 0.0000E+00 


“2.9A495E-03 F.b991E-05 3.084E-03 -3.2107E-04 2.5089E-01 2.5089E-01 4.2573E-03 -1.7636E-01 
O.0000E+00 O.0000E+00 0.0000E+00 0.0000E+00 -S.S123E-01 S.SI23E-01 0.0000E+00 0.0000E+00 


1.9937E-02 -6.4024E-05 -2.2515E-03 -6.1764E-03 1.2570E-03 1.2570E-03 -4.2192E-02 -4.4181E-03 
Q.0000E+00 0.0000E+00 0.0000E+00 O.0000E+00 S.SB41E-04 -5.SBAIE-04 0.0000E+00 0.0000E+00 


-2.1290E-05 7.1583E-05 4.8423E-03 5.2630E-05 3.2220€-03 3.2220E-03 1.3762E-03 -2.7719E-02 
0.0000E+00 0.0000E+00 0.0000E+00 0.0000E+00 db. 9118E-03 -b.9118E-03 0.0000E+00 0.0000E+00 


2.6489E-03 -2.0743E-03 -1.9729E-02 2.41 118-03 -5.6558E-01 -5.6558E-01 -b.4547E-03 2.6790E-01 
0.0000E+00 0.0000E+00 0.0000E+00 0.0000E+00 7.0275E-02 -7.0275E-02 0.0000E+00 0.0000E+00 


-7,8555E-01 1.6809E-03 1.3494E-02 3.3456E-02 1.4757E-03 L.4757E-03 6. 7821E-02 4.5741E-03 
0. 0000E+00 0.0000E+00 0.0000E+00 0.0000E+00 3.1573E-04 -3.1573E-04 0. 0000E+00 0.0000E+00 
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1.000000000000E +00 


* 


oeooooo0o0co0o0c”ceo 
oeooooqoco0o0odco 


Q. 
~1.835420480000E +01 
-1.192239258000E+01 

1.174827457000E+01 


APPENDIX G 


L MATRIX 
2 
0.0 
0.0 
0.0 
0.0 
0.0 
0.0 
1. 0O0000000000E +00 
0.0 
0.0 
0.0 
0.0 


~1.403831751000E+00 
-1.310703360000E +00 
1.33368603 7000E +00 
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3 

0.0 
0.0 
0.0 
0.0 
0.0 
0.0 
0.0 
1.000000000000E +00 
0.0 
0.0 
Q. 


-2.723467/750000E-02 
~7.691884516000E-02 
-4.335761088000E-02 





APPENDIX H 


A, B, C, G, H, (A-BG-HC) Matrices 
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Thesis rN TORT 


H2897 Harris 
Macomatic CONErOL Of 
a submersible. 


Thesis 


Hoeo7, | Harris ; 
Automatic eontrol 0o-- 


a submersible. 











